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I. INTROD UCT ION 

The extreme importance of automatic control has become 
obvious for example in space vehicle control and missile 
guidance where manual control is not feasible. In addition 
it can provide means to relieve people from tedious routine 
and repetitive manual operations. 



The complexity of 


a submarine 


offers a 


wi d 


e area of 


control problems. Eeep w 


ater and near 


surface d 


epth 


keeping , 


maneuvering, hovering. 


fuel economy. 


safety. 


crew 


co mf ort , 


etc. require precise con 


trols. 








Characteristic for 


a submarine i 


s translation 


in three 


dimensions, where depth 


control is of 


essential 


i m 


portance. 



The automatic control of motion in the vertical plane, i.e. 
depth and pitch control, is the subject of this thesis. 

Three sets of planes, the rudder, the fairwater and 
stern plane, the propulsion system, and a ballast system can 
be used to maneuver the submarine. The objective is to 
design a controller for depth changing maneuvers by 
automatic control of the fairwater and stern plane. 



Previous designs were based on Optimal Control Theory, 
requiring feedback of both position and rate information. 
These informations are easily available when the submarine 
is equipped with an inertial guidance system. Rate 
information may be not available, as for example in the 
German coastal submarines. It may also be a desirable 
feature to have reduced sensor requirements. In these cases 
a different design approach must be used using position 
feedback only. 



7 



This thesis investigates two possible design methods, 
steady-state and total decoupling. As a basis for both 
designs a linear model is developed and validated. 

Steady-state decoupling is achieved by designing a 
cascaded diagonal compensator matrix, using classical 
sfngle-loop techniques. Based on the desired response 
characteristics the total decoupling scheme leads to a 
cascaded compensator matrix with off-diagcnal terms. Both 
designs are simulated and evaluated with respect to 
performance, simplicity of design procedure, and grade of 
complexity. 
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II. SIMULATION MODELS 



A. STANEARE MODEL 

A set of " Standard Equations of Motion for Submarine 
Simulation " was developed by NSRDC (Ref. 1). Equations and 
additional auxiliary equations are repeated in Appendix A. 

These equations are referred to a right-hand orthogonal 
system cf moving axes, fixed in the body with its origin 
located at the center of mass (CG) of the body. The 
x-z-plane is the principle plane of symmetry ( vertical 
center plane for submarines ) ; the x-axis is parallel to the 
baseline cf the body. Angular velocity components, forces, 
and moments are shewn in Fig. 1. 

The equations are written in a form utilizing 
nondimensicnalized hydrodynamic coefficients and are 
applicable to the rigid body motions of submarines and other 
submerged vehicles. Complete sets of hydrodynamic 
coefficients have been determined by NSRDC. The 
coefficients for a fictitious submarine used in this thesis 
stem from a submarine simulation program developed in 
Ref. 2. A notation for the various terms in the equations 
including the hydrodynamic coefficients is given in Appendix 

B. Numerical values of coefficients and parameters are given 
in Appendix C. All coefficients of the terras containing 
( -1) and UC are set to zero. These terms reflect the 
incremental changes in forces and moments - generated by 
propeller rpa - due to either over or underpropulsion. For 
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Figure 1 - SUBMARINE AXES 
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the moderate changes in ahead speed involved in most normal 
maneuvers all terms can be neglected. The coefficients used 
in this thesis apply only to the deeply submerged case, free 
of near- surf ace , bottom, and wall effects. 

As Bef. 1 points out, correlation studies and 
preliminary comparisons have shown that the "Standard 
Eguations" together with a given set of coefficients yield 
accurate predictions of normal maneuvers in submerged ahead 
motion. The "Standard Equations of Motion" will be referred 
to as "Non-linear Model". 



In Bef. 2 H 
Digital Simulatio 
equations was so 
Cramer • s rule dev 
cofactors for th 
this thesis *ere 
parameters. The v 
shewn by Bef. 2. 



•L.Drurey translated these equations into 
n Language (DSL) . The system of six 
lved simultaneously by an approach using 
eloped and programmed by Bef. 3. The 
e set of hydrodynamic coefficients used in 
calculated by Drurey and are used as 
alidity of the DSL implementation has been 



As this model 


contains 


appropriate for the 


chosen des 


the linearity of 


the syste 


linear, representat 


ive appro 


Model". 





non-linear terms it is not 
ign approach which is based on 
m. It was necessary to find a 
ximation of the "Non-linear 
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B. DERIVATION OF THE LINEARIZED MODEL 



This section describes the assumptions, procedures, and 
tests to validate the linear model. 



1. Assump tion s 



* Forward speed is constant 



An attempt to linearize about the axial speed, u, 
which affects nearly every term in the standard equations, 
would imply a great deal of complexity. Thus the forward 
speed was assumed to be constant. This means that either the 
forward speed variations are small and can be neglected or 
if variations are large they impose a control problem and 
will be solved accordingly. 

* Roll angle is small 



In submarine maneuvering large roll angles occur 
only in the fcrm of " Snap Roll ", i.e. high speed plus hard 
over rudder. Under normal conditions depth-changing and 
-keeping maneuvers produce very small roll angles. Therefore 
the roll angle can be neglected. 

* Cross products of inertia may be neglected 



I his 

simulations 
submarines is 



assumption is common 
because the hull and 
approximately symmetric. 



to all submarine 
interior layout of 
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* All terms involving W are neglected 

i 

This is possible because the submarine was assumed 
to be in trim. 

* The submarine can be approximated by a linear model 

The linear equations are assumed to be a valid 
representation in the depth- keep ing and depth-changing mode 
of operation respectively. This assumption is not obvious 
but will be verified via simulation. 

These assumptions lead to the decoupling of the vertical 
plane from the remaining equations. 



2. Derivation of state equa tion s 



As this thesis is only concerned with the vertical 
plane, the linearization of the horizontal plane is omitted. 

Thus the linear equations are (FORTHAN-Notation,see 
Appendix C) : 



4 3 

h * W DCT - UC*d*Q = L *ZQDOT*QDOT + L *ZWDOT*WDCT + 

3 2 

L *ZQDOT*UC*Q + L *ZW*UC*W + 

2 2 

L * DC * (ZDS*DS + ZDB*DB) (1) 



IY*CEOT 



5 

= L *HQDOT*QDOT + 
4 

L *MW DOT* WDOT + 
3 2 

L *UC (MDS*DS + 
E* ZE* PITCH 



4 

I *NQ*UC*Q + 

3 

L *MW*(JC*W + 
MDB*DB) + 

( 2 ) 
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The linearized auxiliary equations are : 



IPIDCT 



LZEOT 



= LQ 

= W - UC^L PITCH 



(3) 

(4) 



Solving equation (1) and (2) for WDOT and LQDOT 
respectively and substituting into each other yields the 
following relations : 



'hdot 
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a a 

12 13 




w 




~b 
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12 


LCDOT 


zz 
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2 1 
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LQ 
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22 


IC 
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L» 
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L PITCH 
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31 
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DS 

DB 



(5) 



which can he written as 



where 



1 1 



12 



13 



21 



x = Ax + BS 



2 7 5 

[L *ZW*UC + L *ZQDOT*MW*UC/ (IY-L *MQDOT)]/y~ 

3 3 5 

[L *ZQ*UC + K*(JC + L *ZQDOT*MQ*UC/ (II-L *MQDOT) ] 

4 5 

■[L *ZQE01*ZB*B/ (IY-L *MQDOT)]/^ 

3 6 3 

[L + L *MWDOT*ZW*UC/ (M-L *ZWD0T) ]/ £ 



(6) 



4 7 4 

a _ = [L * M Q C + L *MWDOT*ZQ*OC + L *MWDOT*M*UC/ 
2 2 



(M-L * Z ** DOT) ]/ £ 

i =-B* Zfc/V 
23 £ 
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a =0.0 

31 

a = 1.0 

32 

a =0.0 

33 
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[L 


*ZDS*UC 


1 1 
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[L 


*ZEE*UC 


12 
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[L 
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21 
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*MDE*CJC 
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with 







2 7 

+ L > 

2 7 

+ L * 

2 6 

♦ L = 

2 6 



2 5 

: /(I Y-L : 

2 5 

: /(IY-L » 

2 3 



3 8 5 

/"= 2! - L *ZWDOT - L * ZQDOT* MWDOT/ (IY-L *i1QDOT) 

5 8 3 

£= IY - L *MQDOT - L *MWDOT*Z QDOT/ (M - L *ZWDOT) 



Vector equation (5) describes the state variable 
representation of the linearized, vertical plane equations 
of motion. However the state vector does not contain ZDOT 
but W. W represents the component of u in the z-direction, 
in order tc make the depth a state variable one wants to use 
LZDCT which represents the depth change in the z-direction. 
Thus the linearized auxiliary equation (4) is used for the 
transformation 



LZDCT = V - UC*LPITCH 



15 



By definition 





LZDCT 




W 


= 


LQ 


IX 

II 


LQ 




LFITCH 




LPITCH 



Using the linear operator M , the new set of state 
variables is formed 



x = Mx 



where 



a = 



1 0 -UC 

0 1 0 
0 0 1 



equations (6) become 



then 



but 



thus 



-1c 
M X 



AM X + BR 






* -K 

X = MAM X + MBR 



(V A/ /■W 



MB = B = B 

— f ->j *** -v 



-1 



X = MAM X + BR 

v r*- v 

which can te rewritten as 



x = Ax + BR 



( 7 ) 
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where 



A 

A = 



1 1 


12 


13 


a 


a 


[a 


2 1 


22 


21 


0. 0 


1 . 0 




te 


written 


as 



23 



0.0 



A 

A = 



2 1 

A 1 1 * 0 C A 1 2 *UC [A13+A14*UC ] 

2 

A21*DC A2 2 *UC [ A23*UC +A24 ] 



and 



A 

a 

/>/ 



= oc 



.0 


1 . 


0 


o 

t 

o 


Ell 


B12 






E2 1 


E22 






_G.G 


0.0_ 









Using 


the numerical values 


for the 


hydrodynamic 


coefficients 


given in Appendix C 


and letting 


UC still be 


variable, the 


constants of the A and 


E matrices 


ar e 


A 1 1 


= -1.726 


-3 

10 






A 1 2 


= -0.706 


2 






A 1 3 


= C.0128S 






A 1 4 


= - 1 .728 


-3 

10 






A2 1 


= 1.684 


-5 

10 






A22 


= -6.365 


-3 

10 






A23 


= 1.884 


-5 

10 






A24 


= -2.522 


-3 

10 
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B 1 1 


= -6.666 


-4 

10 


B 1 2 


= -3.871 


-4 

10 


B2 1 


= - 1.465 


-5 

10 


E22 


= 3.19C 


-6 

10 



C. VALIEATICN OF LINEAR MODEL 

The objective of this section is to compare the dynamics 
of the standard model with the developed linear model. 

In crder to compare both models, they should be in the 
same initial state, i.e. besides the identical initial 
conditions both models have to be " in trim One 
linearizing assumption was that the model will be in trim at 
all times. Therefore the standard model was brought into 
"neutral conditions" for the given test speeds, in order to 
avoid additional forcing terms. This procedure will be 
described explicitly in a later chapter. 

Any total system response can be viewed as having two 
components: forced and free. The forced component includes 
the complex frequencies of the forcing functions, the free 
component the complex or natural frequencies of the system. 
Beth response components were checked via simulation. 
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• In itial cond ition r esponse 

It has expected that for small perturbations the 
deviations between both models should be small. Therefore 
initial conditions of 2.5° in pitch where tested first. 
The initial value of the second variable LZDOT was defined 
as -UC*sin (initia 1 pitch), based on the auxiliary equation 
for depth change. 

lest runs over 400 sec in the speed range 3-15 
knots were performed simultaneously for both models. 
Table 01 shows the max. differences between the model 
responses. Fig. 2-11 are a representative selection of the 
depth change and the pitch behavior. In each figure curve 1 
represents the non-linear, curve 2 the linear model. 
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Table 01 - Initial condition response to 2.5 ° pitch 
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Figure 2 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 2.5 SPEED = 3 KN 
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Figure 3 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 2.5 °, SPEED = 3 KN 
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DEPTH CHANGE - .4 FT/SEC PER INCH 




TIME - 80 SEC PER INCH 

Figure 4 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 2.5 °, SPEED = 7 KN 
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PITCH - 2° PER INCH 



n 

o 




o 



1 1 1 f 

-J. 0. .fi OJ S'S-JC 

.cc . * 

TIME - 80 SEC PER INCH 

Figure 5 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 2.5 °, SPEED = 70 
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Figure 6 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 2.5 SPEED = 9 KN 
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Figure 7 - INITIAL CONDITION 
INITIAL PITCH = 2.5 SPEED 



RESPONSE 
= 9 KN 
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Figure 8 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 2.5 SPEED = 11 KN 
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Figure 9 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 2.5 SPEED = 11 KN 
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Figure 10 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 2.5 °, SPEED = 15 KN 
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Figure 11 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 2.5 SPEED = 15 KN 
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As cne can readily observe, all deviations are small 
for this initial condition, which indicates that the 
dynamics are nearly identical for small perturbations. 

The maximum pitch angle expected in normal 
operations is limited to about 45 °. Therefore this initial 
condition was simulated as well. As for the initial 
condition of 2.5° the max. deviations are summarized in 
Table 02. In Fig. 12-23 curve 1 represents the non-linear, 
curve 2 the linear model. 



The second set of initial conditions, which 
represents rather large perturbations, still leads to very 
similar dynamic behavior, but the deviations increased 
substantially. This was expected as the angle approximation 

sin 0=0 



is rather crude for angles of this magnitude. In addition 
to that the constant, speed assumption is not as valid as for 



IC = 2.5°. 
observed 



For both sets of initial 
that increasing speed tends 



condition it is 
to increase the 



deviations between both trajectories. 
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Table 02 - Initial condition response to 45. ° pitch 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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r r 




TIF1E - 30 SEC PER INCH 



Figure 12 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 45 °, SPEED = 3 KN 
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PITCH 




i 



-P- ■>, 

TIME - 80 SEC PER INCH 



Figure 13 - INITIAL CONDITION RESPONS 
INITIAL PITCH = 45 °, SPEED = 3 KN 
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DEPTH CHANGE - 6 FT/SEC PER INCH 




TIME - 80 SEC PER INCH 

Figure 14 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 45 SPEED = 5 KN 
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PITCH - 14° PER INCH 
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i . 



•<l: 



TIME - 80 SEC PER INCH 



Figure 15 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 45 °, SPEED = 5 KN 
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DEPTH CHANGE - 6 FT/SEC PER INCH 



O 




TIME - 80 SEC PER INCH 

Figure 16 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 45 °, SPEED = 7 KN 
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PITCH - U° PER INCH 
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Figure 17 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 45 °, SPEED = 7 KN 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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-f-. i: 



I 



TIME - 80 SEC PER INCH 

Figure 18 - INITIAL CONDITION 
INITIAL PITCH = 45 ° r SPEED = 



RESPONSE 
9 KN 



39 



PITCH - 14° PER INCH 
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TIME - 80 SEC PER INCH 

Figure 19 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 45 SPEED = 9 KN 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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TIME - 80 SEC PER INCH 



Figure 20 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 45 SPEED = 13 KN 
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PITCH - 14° PER INCH 
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Figure 21 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 45 SPEED = 13 KN 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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TIME - 80 SEC PER INCH 



Figure 22 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 45 SPEED = 15 KN 
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PITCH - 14° PER INCH 
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- j . i: 



TIME - 80 SEC PER INCH 

Figure 23 - INITIAL CONDITION RESPONSE 
INITIAL PITCH = 45 SPEED = 15 KN 
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2 . 



Forced response 

As the models considered are deeply submerged and in 
trim, the planes exert the only relevant forces. It was 
considered best to test the response of both models 
(excluding actuators) to sinusoidal forcing functions, 
because in the controlled system the rudder excursions due 
to depth and pitch changes are expected to be sinusoidal. 

The following forcing functions were chosen for both 
planes separately and three different speeds (3, 9, 15 

knots) : 

A*sin (3* t) 

where A = 35°, 15°, 5° 

and E = 5.73, 2.87 °/sec 

the magnitude of the amplitude was limited tc 35°, 
because this is an approximate, mechanical limit. 

The max. deviations are summarized in Table 03-05. Curve 1 
and 2 in Fig. 24-69 show the responses of the non-linear and 
linear model respectively. 



45 



Table 03 - Speed 
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DEPTH CHANGE - 6 FT/SEC PER INCH 




: i-j- 2.- :: 



TIME - 80 SEC PER INCH 

Figure 24 - FORCED RESPONSE, 3 KN 
LDB = 35 0 SI N . 1 t 
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PITCH - 14° PER INCH 
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TIME - 80 SEC PER INCH 

Figure 25 - FORCED RESPONSE, 3 KN 
LDB = 35 °SIN .1 t 
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DEPTH CHANGE 
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TIME - 80 SEC PER INCH 

Figure 26 - FORCED RESPONSE, 3 KN 
LDS = 5 0 SI N . 1 t 
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PITCH - 14° PER INCH 
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\ — 



TIME - 80 SEC PER INCH 

Figure 27 - FORCED RESPONSE, 
LDS = 5 0 SI N . 1 t 



2 






3 KN 
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DEPTH CHANGE - 6 FT /SEC PER INCH 
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i- j ; 

<L? 

TIME - 80 SEC PER INCH 

Figure 28 - FORCED RESPONSE, 
LDS = 1 5 ° SI N . 1 t 




3 KN 
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PITCH - 14° PER INCH 
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v* \ -p i, 2>.:: 

<n : 

TIME - 80 SEC PER INCH 

Figure 29 - FORCED RESPONSE, 3 KN 
LDS = 15 0 SIN .1 t 
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DEPTH CHANGE - 6 FT/SEC PER INCH 




MO 



TIME - 80 SEC PER INCH 

Figure 30 - FORCED RESPONSE, 3 XN 
LDB = 15 0 SI N .05 t 
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PITCH - 14° PER INCH 
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TIME - 80 SEC PER INCH 



Figure 31 - FORCED RESPONSE, 3 KN 
LDB = 15 ° SI N .05 t 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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i.j. 2..JJ 
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TIME - 80 SEC PER INCH 

Figure 32 - FORCED RESPONSE, 3 KN 
LDS = 15 °SIN .05 t 
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PITCH - 14° PER INCH 
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TIME - 80 SEC PER INCH 

Figure 33 - FORCED RESPONSE, 3 KN 
LDS = 15 ° SI N .05 t 
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Table 04 - Speed 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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:*?. :: 






s*:n 



TIME - 80 SEC PER INCH 



Figure 34 - FORCED RESPONSE , 9 KN 
LDB = 15 0 SIN . 1 t 
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TIME 



80 SEC PER INCH 



Figure 35 - FORCED RESPONSE, 
LDB = 15 0 SI N . 1 t 



9 KN 
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DEPTH CHANGE 
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TIME - 80 SEC PER INCH 



Figure 36 - FORCED RESPONSE, 9 KN 
IDS = 5 °SIN . 1 t 
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PITCH - 14° PER INCH 
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TIME - 80 SEC PER INCH 

Figure 37 - FORCED RESPONSE, 9 KN 
LDS = 5 °SI N . 1 t 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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TIME - 80 SEC PER INCH 

Pigure 38 - FORCED RESPONSE, 9 KN 
LDS = 15 0 SI N . 1 t 
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PITCH - 14° PER INCH 




TIME - 80 SEC PER INCH 



Figure 39 - FORCED RESPONSE, 9 KN 
LDS = 15 ° SI N . 1 t 
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DKI’TII CIIANGK - 6 HT/SKC 1‘KK INCH 




:mi - SO SIC PER INCH 



Figure 



^0 - FORC'D RESPONSE, 
IDS = 3 5 0 31 N .1 t 



KN 



PITCH - 14° PER INCH 




• j. ^ y ^ 2 o^\ jp -r 

TIME - 80 SEC PER INCH 

Figure ui - FORCED RESPONSE, 9 KN 
LDS = 35 ° SI N .1 t 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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TIME - 80 SEC PER INCH 

Figure 42 - FORCED RESPONSE, 9 KN 
LDB = 5 0 S I N .05 t 
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TIME - 

Figure 43 - 
LDB 



1 j 

o; 2 , j- 

80 SEC PER INCH 

FORCED RESPONSE, 9 KN 
= 5 °SIN .05 t 
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DEPTH CHANGE - 6 FT/SEC PER INCH 




1. 1: * e . t . so..: 

\ i" . 

TIME - 80 SEC PER INCH 

Figure 44 - FORCED RESPONSE, 9 KN 
LDB = 15 0 SI N .05 t 



68 



PITCH - 14° PER INCH 
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TIME - 80 SEC PER INCH 



Figure 45 - FORCED RESPONSE, 9 KN 
LDB = 15 ° SI N .05 t 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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TIME - 80 SEC PER INCH 

Figure 46 - FORCED RESPONSE, 9 KN 
LDB = 35 0 SI N .05 t 
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PITCH - 14° PliK INCH 
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TIME - SO SEC PER INCH 

Figure U7 - FORCED RESPONSE, 9 EN 
LDB = 35 0 S I N .05 t 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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TIME - 80 SEC PER INCH 

Figure 48 - FORCED RESPONSE, 9 KN 
LDS = 5 °SIN .05 t 
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PITCH - 14° PER INCH 
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TIME - 80 SEC PER INCH 

Figure 49 - FORCED RESPONSE, 9 KN 
LDS = 5 0 SI N .05 t 
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DEPTH CHANGE - 6 FT/SEC PER INCH 




TIME - 80 SEC PER INCH 

Figure 50 - FORCED RESPONSE, 9 KN 
LDS = 15 ° SI N .05 t 
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PITCH - 14° PER INCH 
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TIME - 80 SEC PER INCH 

Figure 51 - FORCED RESPONSE, 
LDS = 15 0 SIN .05 t 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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TIME - 80 SEC PER INCH 

Figure 52 - FORCED RESPONSE, 9 
LDS = 35 °SIM .05 t 
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PITCH - 14° PER INCH 




V 



•i.n: 

■ i ^ a 

iu.‘i 

TIME - 80 SEC PER INCH 

Figure 53 - FORCED RESPONSE, 9 KN 
LDS = 35 ° SI N .05 t 
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Table 05 - Speed 15 kn 
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DEPTH CHANGE 




r 



TIME - 80 SEC PER INCH 



Figure 54 - FORCED RESPONSE, 15 KN 
LDB = 35 ° SI N . 1 t 
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PITCH - 14° PER INCH 
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*13 

TIME - 80 SEC PER INCH 

Figure 55 - FORCED RESPONSE, 15 KN 
LDB = 35 °SIN . 1 t 
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Figure 56 - FORCED RESPONSE, 15 KN 
LDB = 5 ° S I N . 1 t 
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Figure 57 - FORCED RESPONSE, 15 KN 
LDB = 5 0 SIN . 1 t 
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DEPTH CHANGE - 6 FT/ SEC PER INCH 
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Figure 53 - FORCED RESPONSE, 15 K N 
LD3 = 15 0 S I N .1 t 
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PITCH - 14° PER INCH 
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Figure 59 - FORCED RESPONS2 r 15 KN 
LDB = 15 0 SIN . 1 t 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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Figure 60 - FORCED RESPONSE, 15 KN 
LDB =35 ° SIN . 1 t 
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PITCH - 14° PER INCH 







TIME -80 SEC PER INCH 

Figure 61 - FORCED RESPONSE, 15 KN 
LDB = 35 0 SI N .1 t 
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DEPTH CHANGE - 6 FT/SEC PER INCH 
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Figure 62 - FORCED RESPONSE, 15 KN 
LDB = 5 °SIN .05 t 
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PITCH - 14° PER INCH 




TIME -80 SEC PER INCH 

Figure 63 - FORCED RESPONSE, 15 XN 
LDB = 5 ° SI N .05 t 
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TIME - 80 SEC PER INCH 

Figure 64 - FORCED RESPONSE, 15 KN 
LDB = 15 0 S I N .05 t 
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PITCH - 14° PER INCH 
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Figure 65 - FORCED RESPONSE, 15 KN 
LDB = 15 0 SIN .05 t 
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Figure 65 - FORCED RESPONSE, 15 KN 
LDS = 5 °SI N .05 t 
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PITCH - 14° PER INCH 
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Figure 67 - FORCED RESPONSE, 15 KN 
LDS = 5 0 SIN .05 t 
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9 68 - FORCED RESPONSE, 15 KN 
LDS = 15 °SIN .05 t 
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PITCH - 14° PER INCH 
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TIME - 80 SEC PER INCH 



Figure 69 - FORCED RESPONSE, 15 KN 
LDS = 15 0 SI N .05 t 
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Thus it has been shown than: 

- Approximation by linear model is valid for small 
perturbations at all speeds. 

- The dynamics of both models are compatible. 

In addition it has been observed, that the 
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linearized model is still valid for large perturbations 
applied ever a short period of time (initial condition 
response) . When large plane angles were applied over a long 

the standard model decreased 
the 



period, the speed of 
substantially, which made 
invalid . 



constant speed assumption 



3. Actuator model 
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which has the Laplace transform of 
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Thus the actuator dynamics will be represented by; 
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(s+d) 
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d. represents the inverse of the time constant, 
which has to be determined. As the rate of the rudder 
deflection depends on the magnitude of the desired angle the 
maximum rate limit is determined by the mechanical limits of 
the rudder, which are assumed to be t 35 ° for this model. 
It was assumed that the maximum deflection is reached in 5 
time constants. As the needed time is about 3 to 3.5 sec, 
the time constant was determined to be 2/3 sec. 



The actuator time constant is fast compared to those 
of the system. Therefore the actuators will be neglected in 
the design of the compensators, but will be included in the 
simulation of the compensated system. 
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III. DESIGN SPECIFICATIONS 



The objective is to design an automatic controller for 
maneuvering in the vertical plane, i.e. depth and pitch 
control. The submarine is considered deeply submerged and 
therefore free from all external disturbances like surface-, 
bottom-, and wall-effects. The dynamics for a depth change 
include the depth and pitch dynamics. The deptn response to 
an ordered depth change should basicly look like a second 
order overdamped or highly damped system response. The pitch 
shall be kept as close as possible to the ordered pitch, 
which under regular conditions will be zero. This submarine 
has no inertial guidance system (as for example the German 
coastal submarines) . Sate information is not available and 
the only states to be used as feedback are depth, pitch, and 
speed. Due to this limited instrumentation the controller 
will have to use cascaded filters. 



* Time reg uireme nts . 

Depth changes at even keel for speeds 



- < 9 kn 


10 


ft in < 


120 sec 




100 


ft in < 


240 sec 



- > 9 kn 


10 


ft 


in < 


60 sec 




100 


ft 


in < 


100 sec 
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Overshoot requirements 



For depth changes 

s’ 

< 1Q0 ft < 5 % 

> 100 ft < 5 ft 

* Pitch deviations 

Always less than ± 2 ° from ordered pitch. 

* Mechanical constraints 

* plane angle limits according to diagram 




Speed in kn 



maximum possible pitch < 45 0 
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IV . 



DESIGN 



A. TRANSFER FUNCTION 



The design approach chosen for this thesis requires the 
system description by the transfer function matrix. Matrix 
equation (7) is the state variable representation of the 
system. The signal flowgraph equivalent for this system is 
given below. An additional integration is included, because 
the depth is a desired output. 
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The input-output relations of interest are DEPTH/DS, 
DEETH/DB , PITCH/DS , and PITCH/DB, because depth and pitch 
will be the measurable quantities and will be used for the 
control . 

Applying Mason's gain rule the input-output relations 
have the form 

2 

Y (s ) N2*s + N 1 *s + NO 

= 4 3 2 

X(s) C4 * s + D3*s + D2*s + D 1 * s + DO (8) 



The coefficients for equation (8) are: 



ZCCT/DS 


• 




N2 


= 


2 

E 1 1*UC 


N 1 


= 


3 

( A 22*B 1 1 - A12*B21) *UC 


NO 


= 


2 2 2 
( E 2 1* ( A 1 3 + A 1 4 * UC ) - B11*(A23*UC ♦ A24))*UC 


D4 


= 


1 


D3 


= 


-(All ♦ A22) *UC 


D2 


= 


2 2 2 
A11*A22*UC - ( A23* UC + A24) - A12*A21*UC 


D 1 


= 


2 2 
A 1 1* (A23*UC + A24)*UC - A21*UC*(A13 + A14*UC ) 


DO 


= 


o 

• 

o 


ZDOT/DB 


: 




N2 




2 

E 1 2 *UC 


N 1 


= 


3 

- ( A22*B 1 2 - A 1 2*3 2 2) *UC 


NO 


= 


2 2 2 
( E 22* (A 1 3 + A 1 4 * UC ) - B12*(A23*UC + A24))*UC 


D4 


= 


1 


D3 


= 


-(All + A 2 2 ) *UC 
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D2 = 


2 2 2 
A11*A22*UC - ( A23*UC * A24) - A12*A21*UC 


D 1 = 


2 2 
A 1 1* ( A23*UC + A24) *UC - A21*UC*(A13 + A14*UC ) 


DO = 


o 

• 

o 


PI1CH/DS 


• 

• 


N 1 = 


2 

E21*UC 


HO = 


3 

( A2 1*31 1 - A 1 1*32 1 ) *UC 


D3 = 


1 


D2 = 


-(All + A22) *UC 


D 1 = 


2 2 2 
A 1 1 *A22 *UC - ( A 2 3* UC + A24) - A12*A21*UC 


DO = 


2 2 
All* (A23*UC + A24) *UC - A21*UC*(A13 + A14*UC ) 


PITCH/DB 


l 


HI = 


2 

E 22 *UC 


NO = 


3 

( A2 1*B1 2 - A 1 1*322) *0C 


D3 = 


1 


D2 = 


-(All + A22 ) *UC 


D 1 = 


2 2 2 
A 1 1*A22*UC - (A23*UC + A24) - A12*A21*UC 


DO = 


2 2 
A11*(A23*0C + A24) *!JC - A21*0C*(A13 + A14*0C ) 



Table 06 through 10 show the root-locations for the 
speed range 1 kn - 15 kn. The charact eristic roots move 
closer to the origin and the damping reduces with decreasing 
speed. This indicates that the overall response cf the 
uncompensated submarine will be much slower for 3 kn than 
for 9 kn cr 15 kn. 
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Table 06 - Characteristic roots 



Speed 


ROCt 


Complex 


roots 




1 


-0.2774 


-2 

10 


-0.5452 


10 


) 

± 


j 


0.4978 


-1 

10 


2 


-0.5650 


-2 

10 


-0. 1085 


-1 

10 


1 

± 


j 


0.484 1 


-1 

10 


3 


-0.876 8 


-2 

10 


-0.1613 


-1 

10 


1 

± 


j 


0. 4604 


-1 

10 


4 


-0.1235 


- 1 i 

10 


-0.2114 


- 1 

10 


1 

t 


j 


094245 


-1 

10 


5 


-0. 1705 


- 1 

10 


-0.2563 


-1 

10 


1 

± 


j 


0.3716 


-1 

10 


6 


-0.2527 


- 1 

10 


-0.2835 


-1 

10 


1 

t 


j 


0.2908 


-1 

1 0 


7 


-0.4872 


-1 

10 


-0.2347 


-1 

10 


1 

± 


j 


0.2116 


-1 

10 


8 


-0.7068 


- 1 

10 


-0. 1933 


-1 

10 


1 

± 


j 


0. 2032 


-1 

10 


9 


-0.88 1 2 


- 1 

10 


-0. 1744 


-1 

10 ± 


3 


0.2014 


-1 

10 


10 


-0. 1038 


-0.1643 


-1 

10 X 


3 


0. 1999 


-1 

10 


1 1 


-0. 1 186 


- 0 . 1 58o 


1 0 


1 

± 


3 


0. 198 2 


-1 

10 


12 


-0. 1 328 


-0. 1557 


-1 

10 ± 


n 

J 


0.1963 


-1 

10 


13 


-0 . 1467 


-0. 1 546 


10 


1 

± 


3 


0.1940 


-1 

10 


14 


-0.1603 


-0. 1549 


10 


1 

± 


3 


0.1915 


-1 

1 0 


15 


-0. 1738 


-0. 1562 


10 


1 

± 


3 


0.1887 


-1 

1 0 
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Table 07 



Zeros of ?itch/DS 



Speed 


Gain 


Boot 


1 


-4 

-0.418a 10 


-2 

-0.4370 10 


2 


-3 

-0.1674 10 


-2 

-0.8739 10 


3 


-3 

-0.3766 10 


-1 

-0. 1311 10 


4 


-3 

-0.6675 10 


-1 

-0.1745 10 


5 


-2 

-0.1044 10 


-1 

-0.2182 10 


6 


-2 

-0 . 1503 10 


-1 

-0.2619 10 


7 


-2 

-0.2047 10 


-1 

-0.3056 10 


8 


-2 

-0.2674 10 


-1 

-0.3493 10 


9 


-2 

-0.3385 10 


-1 

-0.3929 10 


10 


-2 

-0.4179 10 


-1 

-0.4367 10 


1 1 


-2 

-0.5057 10 


-1 

-0.4804 10 


12 


-2 

-0.6013 10 


-1 

-0.5233 10 


13 


-2 

-0.7058 10 


-1 

-0.5675 10 


14 


-2 

-0.3187 10 


-1 

-0.6 112 10 


15 


-2 

-C.9400 10 


-1 

-0.6549 10 
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Table C8 - Zeros of Pitch/DB 



Speed 


Gain 


Hoot 




1 


0.9111 


-5 

10 


0.9434 


-3 

10 


2 


0. 3644 


-4 

10 


0. 1887 


-2 

10 


3 


0.3200 


-4 

10 


0.2831 


-2 

10 


a 


0.1453 


-3 

10 


0.3768 


-2 

10 


5 


0.2272 


-3 

10 


0.4713 


-2 

1 0 


6 


0.3274 


-3 

10 


0.5654 


-2 

10 


7 


0.4457 


-3 

10 


0.6599 


-2 

10 


8 


0.5822 


-3 

10 


0.7542 


-2 

10 


9 


0.7370 


-3 

10 


0.8484 


-2 

1 0 


10 


0. 9 100 


-3 

10 


0.9428 


-2 

10 


1 1 


0.110 1 


-2 

10 


0.1037 


-1 

10 


12 


0.1309 


-2 

10 


0.1131 


-1 

10 


13 


0. 1537 


-2 

10 


0.1225 


-1 

10 


14 


0.1783 


-2 

10 


0.1319 


-1 

10 


15 


0.2047 


-2 

10 


0.1414 


-1 

10 
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Table 09 - Zeros of Depth/DS 



Speed 


Gain 


Root 


Root 


1 


-2 

-0.1904 10 




-2 -1 
-0.7732 10 ± j 0.5083 10 


2 


-2 

-0.7615 10 




- 1 - 1 
-0. 1546 1 0 ± j 0.4378 10 


3 


-1 

-0.1714 10 




- 1 - 1 
-0.2320 10 ± j 0.2841 10 


4 


-1 

-0.3036 10 


- 1 

0.5803 10 


-2 

-0.3740 10 


5 


-1 

-0.474S 10 


- 1 

0.9089 10 


- 1 

-0. 1366 10 


6 


-1 

-0.6843 10 


0.1183 


-1 

-0.2557 10 


7 


-1 

-0.9316 10 


0 . 1438 


- 1 

-0.3567 10 


8 


-0. 1217 


0. 1685 


- 1 

-0.4489 10 


9 


-C.1541 


0. 1926 


- 1 

-0.5356 10 


10 


-C. 1 S02 


0.2165 


- 1 

-0.6190 10 


1 1 


-0.2302 


0.2400 


-1 

-0.7001 10 


12 


-C.2737 


0.2633 


-1 

-0.7790 10 


13 


-C.3213 


0.2866 


- 1 

-0.8572 10 


14 


-0.3726 


0.3097 


-1 

-0.9343 10 


15 


-094278 


0.3329 


-0.1011 
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Table 10 - Zeros of Depth/DB 



Speed 


Gain 


Root 


Root 


1 


-2 

-0.1106 10 




- 1 - 1 

-0. 1030 10 ± j 0.4792 10 


2 


-2 

-0.4422 10 




-1 - 1 

-0.2059 10 ± j 0.4404 10 


3 


-2 

-0.995C 10 




- 1 - 1 

-0.3089 10 t j 0.3665 10 


4 


-1 

-0.1764 10 




- 1 - 1 
-0.4112 10 ± j 0.2269 10 


5 


-1 

-0.2757 10 


-1 

-0.7499 10 


-1 

-0.2784 10 


6 


-1 

-0.3972 10 


-0. 1049 


- 1 

-0.1853 10 


7 


- 1 

-0.54CS 10 


-0. 1304 


-1 

-0. 1359 10 


8 


-1 

-0.7C65 10 


-0. 1544 


-1 

-0.1020 10 


9 


-1 

-0.8944 10 


-0. 1775 


-2 

-0.7620 10 


10 


-C. 1 104 


-0.2003 


-2 

-0.5510 10 


1 1 


-0. 1336 


-0.2227 


-2 

-0.3718 10 


12 


-C. 1589 


-0.2447 


-2 

-0.2156 10 


13 


-0. 1865 


-0.2667 


-3 

-0.7430 10 


1 4 


-0.2163 


-0.2886 


-3 

0.5368 10 


15 


-0. 2484 


-0. 3088 


-3 

0.1734 10 
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B. STEADY-STATE DECOUPLING 



The derived model represents a linear, multivariable 
system. In order to allow the application of existing 
single-loop techniques, such as Nyquist-Bode-Nichol's 
methods and Root-Locus design, the equations must be 
decoupled. Decoupling requires the system to be 
characterized by a non- sing ular, diagonal transfer function 
matrix. When linear state variable feedback is applied, one 
necessary condition according to Wolovich (Ref. 12) is that 
a system characterized by a (n * m) transfer function matrix 
may not have poles at the origin. The developed linear 
system contains two transfer functions with such poles. 



Ref. 4 develops another approach which decouples the 
steady-state only. This approach uses classical cascade 
compensation and allows the precluded poles at the origin. 
Actually, these poles are used for the decoupling of linear, 
multivaria tie systems. 



A steady-state decoupled system is a system in which 
changes in each input are reflected in a corresponding 
output and only that output, when steady-state is reached. 
Thus mutual interactions are allowed during the transient 
period, but only during this period. 



Using cascade compensation and a diagonal compensator 
matrix 



G = 
c 



cl 1 



0 



0 



g 



c22 



108 



the model configuration becomes: 




where 



G 

P 



g g 

p 1 1 pi 2 

9 9 

p 2 1 p22 



By theorem 2.2 of Ref. 4 the system is steady-state 
decoupled if and only if 



and 



li m 

s-* o 



V s 



(k-1) 



* (I + G G ) /det (I + G G ) 
p c 1 2 pc 



= 0 



(5) 



2 . 



(k-1) 

lim 1/ s * (I+G G ) /det (I+G G ) 

$—o p c 21 pc 



0 



( 10 ) 
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Since 



G G 
P c 



g g g g 

p 1 1 cl 1 pi 2 c22 



g g g g 

p2 1 c 1 1 p 2 2 c22 



we have 



del (I + G G ) = 1+g g + g g + 
pc p 1 1 c 1 1 pz2c22 

g g g g 

p 1 1 p22 c 1 1 c22 



g g g g 

p12 p2 1 cl 1 c22 



and cofactors 



(I + G G ) 

p c 12 

(I+G G ) 

p c 2 1 



g g 

p2 1 c 1 1 

g g 

p 1 2 c22 



( 11 ) 



( 12 ) 

(13) 



K and k are defined according to 
1 2 



(input^ (t) ) = 1/ s 






where the inputs are constants, steps, 
arbitrary amplitude. 



ramps etc, 



• ith 



By substituting (11)/ (12), and (13) into (9) and 

(10) ,and assuming a step input for depth and constant pitch, 
we have the two necessary and sufficient conditions for 
steady-state decoupling : 



1 . lim 


g g 


/ 


D = 0 


(14) 


J-*o 


p 2 1 c 1 1 




2 . lim 


s*g g 


/ 


D = 0 


(15) 


s-»o 


12 22 
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where 



D = det (I + G G ) 
F c 



All g are known. Thus the design for steady-state 
F 

decoupling is the determination of g and g such that 

ell c2 2 

(14) and (15) are satisfied. 

Although the locations of the poles and zercs are 
dependent on the speed their number is independent. 
Therefore the poles will oe called 

p m - 1,2,3... 

i jm 

and the zeros 



z m= 1,2,3... 

i jm 

th 

where ij denotes the element of the matrix and m the m 



pole and zero of the element. 



9 



9 



g 



g 



p 1 1 
P 1 2 
p21 
p22 



k (s+z ) (s+z ) 
11 111 112 



k (s + z ) (s + z ) 
12 121 122 



k 21 ' S ‘ Z 2,1 I 



k (s + z ) 

221 r 



/ sjf 
/ sf 



where 



r= <■♦?,„> <«p„ 2 > < s *p„ 3 i 

When these transfer functions are substituted into 
equations (1h) and (15), both limits go to zero for all 
speeds . 

Thus conditions (1) and (2) are satisfied fox the specified 
inputs. 

1. Design of closed-loo d sy stem 

The previous section resulted in the decoupling of 
the steady-state of the system. However, one must realize, 
that : 

1. the result does not guarantee stability. 

2. steady-state decoupling is only meaningf ul, when 
the closed-loop system is stable. 

Thus it is necessary to consider the stability of the 
clcsed-locp system after the steady-state decoupling has 
been achieved. 

Ref.h investigates a connection between single-loop 
and multivariable systems by properly factorizing the 
closed-iccp characteristic equation. It allows the design of 
multivariable systems by using any suitable single-loop 
method. The primary method chosen will be the roct-locus 
design. 
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2. Stability criter ion 

Ref. 13 and 14 prove that the stability of this 
multivariable system is determined by the zeros of N^(s) 

and N (s) , where 
2 

N (s)/D (s) = det (I + G (s)*G (s) ) (16) 

11 pc 

and 

N (s) = A c (s) *Ap(s)/D (s) (17) 

2 1 

N^(s)/D (s) is in irreducible form, i.e. all common factors 

are cancelled. A c (s) represents the characteristic 

polynomial cf the transfer function matrix G (s) and Ap(s) 

c 

represents the polynomial of the transfer function matrix 

G (s) . Ihe characteristic polynomial cf the transfer 
P 

function is defined as the least common denominator of all 
miners . 



However Ref. 4 devises a method by which it is 
necessary to check equation (16) alone for stability, if: 

1. cancellations are selected systematically by 
using equation (4.5) Ref. 4. 

2. poles of G are carefully selected, which can 

c 

be taken care of in the process of the design. 
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Thus 



det (I + G G ) = 0 (18) 

P c 

represents the characteristic equation of the multivariable 
system. 

Fcr the system under consideration equation (18) 

becomes: 



det (I + G G ) 
F c 



1 + 9 9 

pi 1 c 1 1 



9 9 

p22 c22 



det (G ) 
P 



9 9 

cl 1 c22 



which can be factored 



det (I ♦ G G ) = (1 ♦ g 9)0 
pc p 1 1 c 1 1 



♦ G g ) 
eq c22 



where 



G 

eq 



9 ..(1 ♦ <*etG *9 /9 _J/(1 + 9 ,9 , ) 

p^z p ell p22 p 1 1 cl 1 



(19) 



Ey cancellation of the common roots the equation 
determining the stability of the system becomes 



1 + G g = 0 
eq c2 2 



( 20 ) 



Equation (20) still contains both g and g as 

c 1 1 c22 

unknown functions. It is possible for example to choose g 

c 1 1 

arbitrarily. In this case the only unknown left to be 
designed is g , which means the design is reduced to a 



single-lccp case. But if g has not been chosen properly, 

c 1 1 

G may become very unstable. This can make the design of 
eq 
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very difficult. Thus it is preferable 



to have 



c22 

guidelines in choosing 
pole-zero pattern for G 



eg 

q much easier. 
c22 



g in order to get a reasonable 

cl 1 

which will make the design of 



3- Design Guidelines 

The roots of equation (19) are determined by the 
following expressions: 



1- = g ♦ det (G ) g 

z p22 pell 



2 . C- = 1 * g g 

1 p 1 1 cl 1 



where 



G = G /G (21) 

eg 1 2 



Then 



det (j. + G G ) = G + G g 

p c 1 2 c22 



ds the design is concerned with the poles and zeros 

of G they must be identified. They can be found by 
eg 

considering the functions G and G . From equation (21) it 



can be seen, that the zeros of G are determined bv: 

eg 



Z = Z ♦ P - (P nP) 

Geg G 1 G2 G2 G1 



( 22 ) 
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F = Z +P - (P n ? ) 

Geq G2 G1 G2 G1 



( 23 ) 



Poles and zeros of G and G are dependent on the function 

1 2 

q according to: 
ell 



1 * cet(G )*g / g = 0 

p c 1 1 p 22 



(24) 



1 + q g =0 
pi 1 ell 



(25) 



Therefore the design will proceed as follows: 



1. Design g to achieve a reasonable pole-zero pattern 
c 1 1 

for G 

eg 



a.) Prepare root-locus studies for equation (24) and 

(25), where g = f ( K , s) . K is a real parameter 

c 1 1 1 1 

positive cr negative. The poles and zeros of g 



are 



c 1 1 



determined by 



aa. ) number of free integrators needed to decouple 
the system. 

ab. ) the needs of compensation, which may arise, 
due to desired root locations. 

b.) Prom root-locus studies choose the parameter K^, 

which fixes g . This will be an iterative process as 
cl 1 

both rcct-lccus studies in combination with equations 

(22) and (23) determine the final pole-zero pattern of 

G . 

eg 



1 16 



2. Design cf g in order to meet the system 

c22 

specification. As G is known equation (20), i.e. 

eg 



1 + G g =0 
eg c2 2 

can be studied via root-locus, where g = f (K , s) . The 

c2 2 2 

criteria which determine f (K ,s) are the same as mentioned 

2 

above for f (K ,s) . 

3. With the proper choice of K 

2 

a. ) system stability is guaranteed. 

b. ) the dynamics of the system are fixed. 

c. ) tbe diagonal compensator is determined. 

4. The design is completed. Mow simulation is required to 

check whether the design specifications have been met. If 

the specifications have not been met, a redesign of 

compensator g or even g may be necessary. But every 
c22 c 1 1 

trial provides some insight and helps with the next trial. 



4 . Hoot-locus de sig n 



Following the design guide lines the first step is a 

toct-locus study for the equations (24) and (25). As shown 

in II. B no free integrators for g and g are required 

ell c22 



for the specified inputs. 



The speed range of interest extends from 3 kn to 15 



kn. As the root locations of the system change with varying 
speed, it is not certain whether one compensator set will 
cover the whcle speed range. It seems reasonable to design 
for the medium speed of 9 kn. Afterwards it can be tested 
whether this compensator set is adequate for the whcle speed 
range and whether the variations due to speed can be taken 
care of by either gain variations or other means. It may 
turn out that different compensators are required tc meet 
the design specifications. 

a.) Design of g 

c 1 1 



The icct-lcci for 1+g g =0 where g =K are 

c 11 p 11 c 11 1 

shewn in Fig. 70 K = negative and Fig. 71 K = oositive. 

1 21 

K = positive is clearly undesirable, because there will be 
one branch that extends along the positive real axis tc + 
and will produce a pole on the positive real axis for G 

eq 

The root-loci for 1 + det (G ) *g /g =0 are 

p c 1 1 p 22 

shewn in Fig. 72 K = negative and rig. 73 K = positive. 
For the same reason as above K ^ has to be negative. 

From the root-loci for K = negative it is obvious 

1 

that further compensation is needed in order to achieve 

reasonable root locations. The following compensator was 
chesen 



2 2 

g = K (s + 0.4) / (s + 4.0) 
c 1 1 1 
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.1 UNITS PER INCH 

Figure 70 - ROOT LOCUS 1+GP11*GC11 = 0 
SPEED = 9 KN, K1 = NEG . 
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.1 UNITS PER INCH 

Figure 71 - ROOT LOCUS 1+G?11*GC11 = 0 
SPEED = 9 KN, K1 = POS. 
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.1 UNITS PER INCH 



Figure 72 - ROOT LOCUS 1 + DET (GP)/GP22*GC1 1 = 0 
SPEED = 9 KN, K 1 = NEG. 
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£ 



— H- 



Figure 73 




• 1 UNITS PER INCH 



ROOT LOCUS 1 + DET (GP) /GP22 *GC 1 1 
SPEED = 9 KM, K1 = POS. 
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This compensation resulted in Pig. 74 for 

1 + c g =0 and Fig. 75 for 1+det (G )g g =0. The 
'ell pll P c 1 1 p 1 1 

rocts of Fig. 74 represent part of the poles of G -By 

eg 

means of the compensation all roots Jere constrained tc the 

stable region. The roots of Fig. 75 will fcrm the zeros of 

G . Although this compensation did not pull the unstable 
eg 

branches considerably to the left half plane, it does not 

mean that the system will not be well behaved, because the 

system behavior will in the end be determined by the poles 

of G and g 

eg c22 

As Eef. 4 in eguations (6-33) points out, the poles 

and zeros cf G are determined as follows: 
eg 



Poles: P 


= Z 


+ P - 


(? ^ 


P 


Geg 


G 1 


G2 


G2 


G 1 


Zeros: Z 


= Z 


+ F - 


(P n 


P 


Geg 


G 2 


G 1 


G 2 


G 1 



P = P + P 

G 1 gp 1 1 gc 1 1 



) 

) 



Z = {roots from foot-locus 1 + g g =0} 
G 1 pllcll 



P 

G 2 



P 

gp22 



+ P (detG ) g - (P 

p ell gp22 



a P (detG ) g ) 
p c 1 1 



p „ P = P for this system. 

G2 G 1 G 1 
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.1 UNITS PER INCH 



Figure 74 - ROOT LOCUS 1+GP11*GC11 = 
SPEED = 9 KN , K 1 = NEG. , COMPENSATED 






. 1 


UNITS 


PER INCH 


Figure 75 - 


ROOT 


LOCOS 


1 + DET (GP) /GP22*GC1 1 = 0 


SPEED = 


9 KN, 


K 1 = 


NEG., COMPENSATED 
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Thus the Ecles of G are: 

eg 



P 

Geg 



and the 



Z 

Geg 



P -{0.0}+ {roots from root-locus 1+g g =0} 
g p 1 1 pi 1 cl 1 



zeros of G are: 
eg 



{roots from root-locus 1+detG g /g =0} . 

p c 1 1 p22 



G has four known poles, namely the ooles cf the 

eq 

system transfer function g . The remaining poles and 

pi 1 

zeros have to be determined from the compensated roct-locus 
studies Pig. 74 and Pig. 75 . 



Tc get an idea how the pole-zero pattern of G will 

eg 

behave with varying K both root -loci are superim pos ed in 



Fig. 76 The additional poles of g - {0.0} are added. 

pi 1 

They are independent of K and therefore fixed. 

1 



b.) Design cf g 

c22 



As the gain K is important for the magnitude 



plane deflection cf the fairwater planes the problem 
cnly to find adeguate root locations, but also to pic 
right gain. Two different gains for K were chosen 



determine 


two 


different 


sets of 


pole 


and zero 


location 


G , thus 
eg 


the 


choice of 


K fixes 

1 


the 


dynamics 


of the 



cf the 

is not 
k the 
which 

s for 
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.1 UNITS PER INCH 



Figure 76 - SUPERPOSITION OF FIG. 74 AMD FIG. 75 
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open-loop system G . The closed-loop poles are now 

eq 

determined by the root-locus study for 1+G g =0. Where 

eq c 22 

q = K . The gain-compensated studies for K =1.48 and K 
c22 2 1 1 

= 75.0 are shown in Fig. 77 and Fig. 78 . Fig. 77 has 

complex roots clcse to the imaginary axis which go to ^ 

asymptotically, which is not desirable as the damping gets 

too small. Fig. 78 shows very similar behavior. Therefore 

it is desired to move the asymptotes to the left, which is 

achieved by 



g =K (s+0.5)/(s + 10.0) . 
c22 2 

The results of this compensation are shown in Fig. 79 
Fig. 80. for K = 1.48 and K = 75.0 respectively. As 



compensated root-locus for K 
stable for all values of K *K 



1 .48 
The 



indicates , 
root- lccus 



G will 
eq 

for K 



2 eq 1 

75.0 has zeros in the right half plane and will limit 

value of K *K in order to maintain stability. 

2 eq 



and 

the 

be 

the 



As many poles are clustered around the origin, it is 
difficult to tell which roots will be dominant. A time 
response could reveal the dominant roots, but as the system 
has to be simulated in order to check the compensation 
anyhow, because both outputs have to satisfy the design 
specifications, it seems more reasonable to simulate the 
total system. From the simulation results it will be judged 
whether the compensation was sufficient or if further 
compensation is necessary. 
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. 1 UNITS PER INCH 



Figure 77 - ROOT LOCUS 1 +G (EQ) *GC22 = 0 
SPEED = 9 KN, K1 = 1.48 
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-h- 



Figure 79 




.1 UNITS PER INCH 



- ROOT LOCUS 1+G(EQ)*GC22 = 0 
SPEED = 9 KN, K 1 = 75. 



130 




.1 UNITS PER INCH 



Figure 79 - ROOT LOCUS 1+G(SQ)*GC22 = 0 
SPEED = 9 KN, K1 = 1.48, COMPENSATED 
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.1 UNITS PER INCH 



Figure 80 - SOOT LOCUS 1 +G (SQ) *GC22 = 0 
SPEED = 9 KN, XI = 75., COMPENSATED 
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5. 



Simulation of compen sat ed linear mo del 



a. Determination of gain constants 

As mentioned above the roots of G will always be stable 

eg 

if a value of K = 1.48 is chosen. Thus this value was 

1 

picked for the initial simulation trials. The root-locus for 

G for this choice of K is shown in Fig. 79 . The next 
eg 1 

step is to find the gain constant K^. The gains shown in 

Fig. 79 represent K *K . In order to determine X , K 

2 eg 2 eq 

has to be found. 

Because 



G 

eg 



g +det (G ) 
p22 p 



*9 /1 + 9 9 

c22 p 1 1 c 1 1 



-2 7 9 

= (-. 3385 1 0 ) (s ♦...)/ (s <-...) 



-2 

K = -.3385 10 
eg 



Therefor e 



K = (gain from root-locus) /K 
2 eg 

The only roots which change significantly with increasing 
gain are those which go to ^ . A reasonable value for 



60, because : 



seems to be K = 
2 



- K is not too large (to avoid excessive rudder 



deflections) 



- damping is greatest in this region. 



Six simulation runs were performed using the 
as pointed out above and variatons of them, 
depth change is 10 ft., the ordered pitch is 0 
The results are shewn in Table 11. 



chosen values 

The ordered 
o 



1 34 



Table 11 - Parameter study for gains 
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DEPTH - 2 FT PER INCH 



C' 

v* 




SI} 



TIME - 80 SEC PER INCH 



Figure 81 - RON 1 
10 FT DEPTH CHANGE, 9 KN 
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DEPTH - 2 FT PER INCH 
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TIME - 80 SEC PER INCH 



Figure 82 - RON 2 
10 FT DEPTH CHANGE, 9 KN 
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DEPTH - 2 FT PER INCH 
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TIME - 80 SEC PER INCH 



Figure 83 - RON 3 
10 FT DEPTH CHANGE, 9 KN 
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DEPTH - 2 FT PER INCH 




I -♦ 

I 

f 3 
1 J 

O 

“1 ! T~ 

a i. ;P. j: «: .. C 

TIME - 80 SEC PER INCH 




Figure 84 - RON 6 
10 FT DEPTH CHANGE, 9 KN 
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PITCH - 1° PER INCH 




TIME - 80 SEC PER INCH 

Figure 85 - RON 6 
10 FT DEPTH CHANGE, 9 KN 



mo 



PLANE DEFLECTIONS - 4° PER INCH 
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Figure 86 - RUN 6 
10 FT DEPTH CHANGE, 9 KN 
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All these test runs showed that the compensated system is 
stable as expected and that the steady-states are reached 
independently without error. The plane angles increase with 
increasing gains. The pitch behavior has basically the same 



form for 


all 


runs . In 


t 


he 


initial 


phas 


pitches 


in 


the direction 


of 


the 


depth 


countera 


cted 


by the stern 


Pi 


anes . 


Bef o 


re t h 


is reac 


bed 


the submarine 


P 


i tche 


s in 


the o 
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hes 


st eady-stat 


e i 
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a sin 
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increase 


in 


K reduces 
2 


the 
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f the 






The primary 


task 


of 
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maintain 


the 


ordered pi 


tch 




i. e. 


in th 
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to count 


er ac 


t the momen 


ts 


ge 


nerated by 
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As the 1 


ever 


arm of the 


St 


er 


n planes i 


s gr e 


of the f 


air w 


ater planes 
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he 


stern plane 


significant! 


y smaller. 
















The fairwat 


er 


?1 


ane 


angle 


s ex 


specific 


at io 


ns in run 


4 


an 


d 5 , 


which 


eli m 


from fur 


ther 


considerat 


ion 


s 


and 


shows 


tha 



to 



should be 



smaller than 2.0. 



Sun 1 : 

K = 1 . K =15. 

1 2 

The ordered depth was reached with very small overshoot, but 
the system showed a big undershoot of 10.83 after the first 
peak. This is due to the fact that at the time the ordered 
depth is reached, the pitch is greatest in the positive 
direction. This is not desirable. 
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Run 2 : 



F = 

1 

The increase in 
plane deflection. 



.5 K = 15. 

2 

K leads to an increase in the fairwater 

1 

The depth change is accelerated and the 



pitch deviations increase, which in turn leads tc greater 

stern plane deflections. The amplitudes of the oscillations 

increase, the overshoot reaches 11.4% and the undershoot 

11.4%. As the fairwater planes have reached about the 

allowed deflection limits K will not be increased anv 

1 



further. The action taken will concern X onlv. 

2 



Run 3 : 



K = 1 .5 K = 40. 

1 2 

The increase in resulted in larger stern plane 

deflections, which damped the pitch more than before. Due to 

the smaller pitch changes which at the same time support the 
depth response, the deviations are decreased significantly 
and die out rapidly. The trade-off which has to be 
considered is that increasing the damping will result in 
longer tines until the ordered depth is reached. 

Han 4 and 5 : 

are not considered as mentioned above. 
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Hun 6 : 



K =1.5 K =60. 

1 2 

This further increase in K confirmed the previously 

2 

observed tendency. The overshoot is decreased to 3.6 X and 

there is essentially no undershoot. Both run 3 and 6 satisfy 
the design specifications. But run 6 shows clearly the more 
desirable behavior as the pitch is smaller, the overshoot is 
less and the depth accuracy is more important than the small 
sacrifice in time, as all these depth maneuvers represent 
standard depth changes and no emergency dives. 



b. Check for valid speed range 



Sc far the compensator is designed for 9 kn. The 
sensitivity cf the compensated system to speed is important 
for two reasons. First, the constant speed assumption for 
the linear model is not quite accurate, because on our 
submarines the speed is ordered in fora of rpm. The actual 
speed varies with rudder deflections and pitch angle. These 
influences result in small speed changes. This phenomenon 
was observed in the comparative test runs with the linear 
and non-linear models. Second, it is of interest to find the 
speed range where this compensator still yields a 
satisfactory behavior which is within the design 
spe cif ications . 



designed 
kn to 
Table 12 



Therefore simulation runs with the compensator 
for 9 kn were performed for the speed range from 3 
15 kn at 2 kn-intervals . The results are shewn in 
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Table 12 - 10 ft depth change 



Figure 
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DEPTH - 20 FT PER INCH 




•<U 1 

TIME - 80 SEC PER INCH 

Figure 87 - RON 1 
100 FT DEPTH CHANGE, 3 KN 
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<•0 



TIME - 80 SEC PER INCH 



Figure 88 - RUN 2 
100 FT DEPTH CHANGE, 5 KN 
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Figure 89 - RUN 3 
100 FT DEPTH CHANGE, 7 KN 
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TIME 



80 SEC PER INCH 



Figure 90 - RON 5 
100 FT DEPTH CHANGE, 11 KN 
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Figure 91 - RUN 6 
100 FT DEPTH CHANGE, 13 KN 
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Figure 92 - RUN 7 
100 FT DEPTH CHANGE , 15 KN 
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As can be seen from Table 06 the poles of the characteristic 
equation of the open loop system transfer functions move 
closer tc the origin of the s-plane with decreasing speeed, 
which should lead to a slower response. At the same time the 
damping- ratio decreases with decreasing speed. All test runs 
reflect this observed tendency. 



* Run 4-7 : 

The time, at which the ordered depth was reached for the 
first time, is acceptable. The overshoot is within the 
design specifications. The plane angles never exceeded the 
limits and the pi tch is small. Small gain variations led to 
a shift in the trade-off between response time and 
overshoot. The improvements which resulted from tests were 
not significant enough to justify the complexity of gain 
switching. Thus the designed compensator will cover the 
entire speed range from 9 to 15 kn very satisfactorily. 



* Run 3 : 



The 7 kn depth 
slightly with 
plane angles 
represents a 
acceptable . 



response exceeds the design specifications 
respect to time and overshoot, while pitch and 
are still within the limits. This speed 
borderline case where the compensator might be 



Run 2 and 1 : 



For these two speeds 
respectively exceed 
required are clearly 



the overshoot of 11.58 % and 
the specifications by far and 
not desired. 



18.77 % 

the times 



It was possible to improve the response time 
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with gain variations, but it was impossible to reduce the 
overshoot to an acceptable value. This indicated that for 
slew speeds gain switching can not be a sufficient measure 
to adjust this compensator. It seems that a redesign of the 
compensator is necessary. 

3 kn and 5 kn are eliminated from further 
considerations as these speeds are not too important for 
submarine maneuvering. 



c. Modification for major depth changes 

The mechanical limit for both rudder deflections is 35 °. 
As outlined in the design specifications these limits are 
reduced to smaller values for higher speeds. Due to the 
linearity of the system major depth changes, which lead to 
proportional depth errors, will cause plane deflections 
exceeding these limits. Therefore it is necessary to prevent 
the planes from exceeding these limits. There are two 
possible actions one can take. 

First, limit the planes. Test runs where this 
scheme was implemented led to unacceptable plane behavior. 

Second, limiting of the error signals. The 
resultant block diagram is: 



gRPEEeP (r) 




Pitch 



error 

unnER 



COMPEN- 

SATOR 



PLANT + 
ACTUATOR 
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ERROR LIMIT 



From 



the design specifications it was determined that the 
error limit function could be approximated by a straight 
line : 

lim = -1.6655+UC + 59.6875 

t 

Where UC is in ft/s. 

This function and the resulting maximum angles are shown in 
the following diagram 




Table 13 shows the simulation runs for 100 ft depth 



change. 



MAX. PLANE ANGLE 



Table 13 - 100 ft depth change 
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DEPTH 



r- 




TIME - 80 SEC PER INCH 



Figure 93 - RON 1 
100 FT DEPTH CHANGE, 7 KN 
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DEPTH - 17 FT PER INCH 




/ - 

/ 



TIME - 80 SEC PER INCH 







Figure 94 - SON 2 
100 FT DEPTH CHANGE, 9 K N 
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DEPTH - 17 FT PER INCH 
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TIME - 80 SEC PER INCH 



Figure 95 - RON 3 
100 FT DEPTH CH ANG E r 11 KN 
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TIME 



80 SEC PER INCH 



Figure 96 - RUN 
100 FT DEPTH CHANGE, 
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Figure 97 - RON 5 
100 FT DEPTH CHANGE, 15 KN 
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PITCH - 1° PER INCH 



/\ 



TIME - 80 SEC PER INCH 



Figure 98 - RUN 5 
100 FT DEPTH CHANGE, 15 KN 
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PLANE DEFLECTIONS - 10° PER INCH 
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TIME - 80 SEC PER INCH 

Figure 99 - RON 5 
100 FT DEPTH CHANGE, 15 KN 
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\ 



After an initial pitch the su 
depth with constant plane 
depth is reached, opposite 
eliminate the depth rate. 

Although it takes 
depth initially the overall 
with increasing speed. 



bmarine approaches the ordered 
deflections. Shortly before the 
rudder angles are used to 

longer to reach the ordered 
time to steady-state decreases 



This completes the design for the speed range 
from 7 kn to 15 kn and all possible depth changes. From here 
on the behavior of the compensated non-linear model will be 
investigated under special conditions, like turns, out of 
trim conditions, etc. 

The final block diagram and the DSL-Program are shown in 



App. D. 
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C. TOTAL DECOUPLING 

The previous design led to a steady-state decoupled system, 
where both outputs were influenced by a single input during 
the dynamic period. In our case the pitch encountered was 
small. In order to keep the submarine at even keel for zero 
pitch input at all times the system has to be totally 
decoupled. One method to achieve this behaviour for a 
multivariable system will be analysed and applied to the 
linear model. 

The system configuration chosen for this design is: 




The closed loop system can be represented by: 




which can be combined to, as will be shown: 



U 



r 






■> 
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T is the desired overall transfer function which determines 
the desired overall respones. 

Therefore 

T = PG 



thus 



-1 

G = F T 

Frcm the block diagrams: 

Y = ID 

Y = FX 
X = CE 

E = 0-rY 



Thus 



Y = FC[ U-FY ] 



or 



- 1 

Y = [I + PC? ] PCU 



and 



- 1 

T = [I + PCF ] PC = PG 
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solving for compensator C results in 

- 1 

C = G[ I - FT] 

In the compensation used for this design the feedback gain 
matrix is the identity matrix, thus 



-1 

C = G[ I-T ] 

-1 - 1 
= E T[ I-T ] . 

Thus the ccapensator is determined by the plant, which 
is known, and the desired overall transfer function T. 

In order to determine the compensator which decouples 
the system at all times, one has to: 



define the desired response according to the system 
specifications. This determines the overall transfer 
function T. 



- 1 

find G = P T and check for realizability. 

- 1 

determine C = G[ I - T] 



Applying 
outlined the 



unity feedback and using casade compensation as 
blockdiagram for the linear model becomes: 
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Figure 100 - BLOCK DIAGRAM 
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As can be seen from the block diagram the requirements 
for total decoupling can be stated in a different way. 

It is required that 



eg = -c g 

11 p2 1 21 p22 



and 



(26) 



eg = -c g 
12 c 1 1 22 p12 



(27) 



Single loop methods can be applied to design the 

compensators c and c to guarantee the desired response. 

1 1 22 

Once c and c are determined the compensators c and c 

11 22 12 21 

can be calculated from (26) and (27) . 



-1 

As Ref. 15 shows C is realizable if G and (I - T] are 
realizable. A rational function in s is physically 
realizable as a voltage transfer function, if the following 
conditions are met: 



the coefficients of the function must be real, 
the order of the numerator must be less or equal 
to the order of the denominator. 

there are no poles in the right half plane and poles 
on the imaginary axis must be simple. 



1 . Design 

It is desired that the transient response has no overshoot 
and has an acceptable rise time. Ihe following transfer 
function is chosen for both outputs 
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2 



t = t 

1 1 22 



S +c< 



t = t =0, because the system is to be decoupled, 

12 21 



Bellowing the previously outlined design steps. 



-1 

P +T has to be determined, 



The plant matrix has the following elements 



Vi 3 v< 2et0s v, )/Sir 



g = k (zeros g )/sf 

p 1 2 12 p 1 2 0 



g = k (zeros g ) / \r 

p 2 1 21 n2l"0 



p 2 1 



g = k (zeros g ) /^ 
p22 22 p22 * 



Thus 



-1 



* ( zeros 9 ) /y- -k (zeros g ) /v- s 

22 p22 o 12 p 1 2 4 

•k (zeros g ) //■ k (zeros g )/v>s 

21 p21 5 11 pi 1 & _J 



g g - g g 

pi 1 p22 P 12 p2 1 



It can be shewn that 



g g - g g = i/s r 

p 1 1 p22 p 12 p2 1 13 
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Therefore 



-1 



k (zeros g )s -k (zeros g ) 

22 p22 12 p12 



-k (zeros g ) s k (zeros g ) 

21 p2 1 11 p 1 1 



P P 

11 12 



P D 

2 1 '22 



and 



-1 2 2-1 
G = F T = [d. (s + <k) ]P 



The next step is tc find 



1-t 0 

22 



[I-T j 



-1 



0 1-t 



1 1 



(1-t ) (1-t ) 

1 1 22 



(s+c<) /s(s+2rt) 



(s+d) /s (s +2d) 
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Finally the compensator matrix C can be determined: 



-1 

C = G[ I-T ] 



c c 

11 12 



c c 

21 22 



where 



c = ot k (zeros g )/(s+2ol) 

11 2 2 p 22 



2 

c = k (zeros g )/s(s + 2oO 

12 12 p 1 2 



c = -cLk (zeros g )/(s+2<£) 

21 21 p21 



2 

c = ck. k (zeros g )/s(s + 2o() 

22 11 p 1 1 



The elements of the compensator for this specific 
design consist of the zeros of the plant transfer function 
and poles which depend on the desired response. As the zeros 
of the plant and probably the time constants of the desired 
response depend on the speed of the submarine, it can be 
expected that the compensator is highly dependent on speed. 

The realizability of C is guaranteed, if G and 

- 1 

[I - T] are realizable. It can easily be seen that for all 
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- 1 

elements of G and [I - T] all three above mentioned 
conditions are satisfied. 



2. Simula tion 



In order to check the design the system was simulated for a 
speed of S kn. The choice of the overall transfer function 



2 2 

t = t = . 2 / (s+ . 2) 
11 22 



t = t = 0 
12 21 



should lead to an overdamped response, which reaches the 
ordered depth in about 60 sec. From Tables 06 - 10 and the 
defined overall T it follows : 



-1 

c = -. 31 945 10 (25 . u52s+ 1) / (2. 5s+ 1) 



c = -. 38 194 (-5. 192 1s+1) ( 1 8 . 6 7 1 s ♦ 1 ) /s ( 2 . 5 s + 1 ) 



-2 

c = . 150 17 10 (- 1 17. 87s+ 1) / (2 . 5s+ 1) 



- 1 

c ^ =-. 29056 10 (5.6338s+1) ( 131 .23s+1)/s (2. 5s+ 1) 



* Unconstrained trials: 

In the first simulation the submarine had to change the 
depth by 10 ft at even keel. The simulation showed the 
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expected response, i.e. the depth was reached after 50 sec. 

-5 

without overshoot. The pitch was of the order of ±10 . This 

deviation can be explained by round-off and truncation. 

In the design the physical constraints on the planes were 
neglected. As it turned out these constraints were exceeded 
by far. Due to the step input of the ordered depth the 
fairwater plane angle increased initially to 117° and 
exceeded the limit of 30° for about 4.5 sec. The max. stern 
plane angle was about 25°. Obviously further compensation 
is necessary. 

Another important aspect is the sensitivity w.r.t. 
speed. Ikerefore the submarine was run with the same 
compensator for 7 and 11 kn. 

For 7 kn the depth response was oscillatory with an 

overshoot of 7.6%. The pitch oscillated with a amplitude of 

/ 

1 0 

For 11 kn the depth response was oscillatory with an 

overshoot of 1%. The pitch oscillated with an amplitude of 
.09°. As expected the system is no longer decoupled, because 
the "correct" compensator depends among others on the zeros 
of the system, which in turn vary with speed. As the depth 
response deviates significantly from the desired response 
with change in speed, it can be concluded that the 

compensator, designed for a specific speed, covers only a 
relatively snail interval. 

* I iplementa tion of constraints : 

The two constraints are the rate limit of the planes and the 
max. angle allowed for a specific speed. The rate limit is 
taken care of by the actuator. The angle can be kept within 
its limits (ca. 30° for 9 kn) using either a limit on the 
signal applied at the actuator or error limitation. For a 
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Figure 101 - TOTAL DECOUPLING 
10 FT DEPTH CHANGE, 9 KN 
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PITCH - 1° PER INCH 
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•<U 



TIME - 80 SEC PER INCH 



Figure 102 - TOTAL DECOUPLING 
10 FT DEPTH CHANGE, 9 KN 
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PLANE DEFLECTIONS - 10° PER INCH 
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TIME - 80 SEC PER INCH 



Figure 103 - TOTAL DECOOPLING 
10 FT DEPTH CHANGE, 9 KN 
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DEPTH - 17 FT PER INCH 




TIME - 80 SEC PER INCH 



o: 



i 



•'*' rjr 



Figure 104 - TOTAL DECOUPLING 
100 FT DEPTH CHANGE, 9 KN 
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PITCH - 1° PER INCH 



r ~ 



r 



TIME - 80 SEC PER INCH 



Figure 105 - TOTAL DECOUPLING 
100 FT DEPTH CHANGE, 9 KN 
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PLANE DEFLECTIONS - 10° PER INCH 




r 




TIME - 80 SEC PER INCH 



Figure 106 - TOTAL DECOUPLING 
100 FT DEPTH CHANGE, 9 KN 
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depth change, generally the required fairwater plane 
deflections are much larger than the stern plane 
deflections. As soon as only one plane limiter is saturated, 
the achieved decoupling is disturbed as can be seen from 
Fig. 100. This saturation occurs for a small depth change of 
only 3 ft. Obviously this scheme is not acceptable. 

The error limitation eliminates these problems. When 
the depth error is limited to 2.5 ft. the initial fairwater 
plane angle stays within the specifications. On the other 
hand the "steady-state" angle for large depth changes turned 
out to be toe small (4.5°) , which leads to an unacceptable 
response time. To achieve both an acceptable initial and 
"steady-state" angle, the limit was kept at 2.5 ft for 1.5 
sec and then increased to a final value of 12.5 ft at a 
constant rate. 

The limiting function used is 



lia = 2.5 ft t < 1.5 

LIM = .2* (TIME-1 .5) +2.5 ft 1.5 < t < 53.5 

LIM = 12.5 ft t > 53.5 

The final block diagram and the DSL-Prcgram are given in 
App . D 

Fig. 101 to 106 show a 10 ft and 100 ft depth 
change. In both cases the depth response is overdamped and 
satisfies the time requirements. The pitch is decoupled and 
the submarine remains at even keel. 



It has been shown that this design approach has the 
following disadvantages: 



Speed range which is covered by individual 
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controller is very small. If the speed deviates too much 
from the design speed the system is no longer totally 
decoupled . 



Ihe high speed dependence requires a complex 
controller with varying pole-zero combinations dependent on 
the speed variations ( system dynamics ) . 

Additionally the " Total decoupling scheme " is 
disturbed by the non-linear terms in the ncn-linear model, 
which are not contained in the linear approximation. 
Therefore this design approach will not be pursued further. 
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V . SIMULATION OF THE COMPENSATED NON-LINEAR MODEL 



A. MODIFICATIONS FOR NON-LINEAR MODEL 

Two of the linearizing assumptions were, that the forward 
speed is constant and that the submarine is always in trim. 

The purpose of this chapter is to investigate the 
deviations from these assumptions and their influence cn the 
behavior cf the submarine during basic maneuvers like depth 
changes, turns, and turns during depth changes. 

Generally trim is a moment, but it is commonly used in a 
different context : 

- "In trim" has the meaning that the submarine maintains 
depth at a given speed with the desired pitch angle. 

- "Out of trim" conditions are heavy or light forward, 
heavy or light aft, heavy or light overall, and combinations 
of these. 

- "To trim" means to change the contents of the tanks by 
shifting water between tanks, flooding tanks from sea, or 
pumping water from tanks to sea. 

The arrangement of depth control or auxiliary and trim tanks 
in the assumed submarine are such that any change in the 
depth control tank does not produce a moment, i.e. the depth 
control tank is at the center of gravity. The trim tanks are 
arranged as shown in Fig. 107. 



1 . Trim 

Frcm experience it is known that a submarine, which is in 
neutral conditions for a certain speed, " gains buoyancy" 
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Figure 107 - CONFIGURATION OP TANKS 
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WATER FLOODED INTO AUXILIARY TANK IN 1000 LBS 



12 




SPEED IN KN 

Figure 108 - CORRECTIONS FOR TRIM 
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WATER TRIMMED FORWARD IN 1000 LBS 



and pitches up with increasing speed and vice versa due to 
dynamic forces acting on the hull, and therefore is no 
longer in trim as defined above. 

Generally a submarine should be in trim at any time 
for a given commmand speed to avoid initial plane 
deflections. This guarantees availability of the full range 
of the planes for maneuvering. Although it is nearly 
impossible tc get the exact trim, it certainly is helpful to 
knew the corrections for different speeds. 

Assuning neutral conditions for 0 kn speed, the 
corrections for trim were found by trial and error. The 
values shewn in Fig. 108 guarantee an approximately neutral 
trim . 



The results confirmed the tendencies observed in 
practice . 



2. Mechanical con stra ints 

The design specifications „ define the maximum plane 
deflections as a function of speed. While the ordered 
revolutions cf the shaft remain constant, the actual forward 
speed ( in direction of the x-axis of the body-fixed 
coordinate sjstem) decreases during maneuvers due to drag, 
which is produced by the deflected planes, the pitch, the 
roll, and the yaw. 

A feedback of the actual forward speed U instead of 
the ordered speed QC modifies the error limiter to 



LIM = - 1 . 6 655*U + 59.6875 



and allows the use of the maximum plane deflections as a 
function cf the actual speed. 
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B. TEST BUNS 



For the test runs to follow the designed compensator, 
the modified limiter, and the trim values for the ordered 
speed according to Fig. 108 are implemented in the 
non-linear mcdel. 

The program and final block diagram are given in App. D. 



1 • Ji C ft depth changes 

Table 14 lists the results of the simulations from 
7-15 kn. Comparing these results with Table 13 it is 
obvious that the dynamic oehavior of both the linear and the 
non-linear mcdel are essentially the same. 

Due to the initially large plane deflections the speed 
decreases by more than 1 kn for all initially ordered speeds 
until the ordered deptn is reached. At this time the plane 
deflections get small and the submarine accelerates to the 
original speed. As predicted, the initial plane angles are 
increased with decreasing speed. 

Although the reduced speeds cause slightly increased 
overshoots, the designed controller is still able to satisfy 
ail the design spe cif ications. 



2. Turns 



One cf the more difficult maneuvers with a submarine 
is to change the depth and the course simultaneously. It is 
of interest to study the behavior of the submarine in a turn 
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first without depth change, because the flow dynamics in a 
turn change significantly. 

The transverse motion of the submarine causes cross flow 
velocities. If the submarine had no appendices this 
crossflow would produce no pitch or other forcing moment on 
the hull. But due to the conning tower and ether appendices 
the flew ever the upper portion of the hull slows down. A 
wake shed from the conning tower also effects the velocity 
distribution aft. 
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Table 14 - 100 ft depth change 
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DEPTH - 17 FT PER INCH 
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TIME - 80 SEC PER INCH 



Figure 109 - RON 1 
100 FT DEPTH CHANGE, 7 KN 
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PITCH - 1° PER INCH 




TIME - 80 SEC PER INCH 



Figure 110 - RUN 1 
100 FT DEPTH CHANGE, 7 KN 
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PLANE DEFLECTIONS - 10° PER INCH 
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TIME - 80 SEC PER INCH 



Figure 111 - RON 1 
100 FT DEPTH CHANGE, 7 KN 



191 



DEPTH 



o 

cn 



CJ 

2 



& 

W 

CL, 

H 

r- 



I 




TIME - 80 SEC PER INCH 



Figure 112 - RUN 2 
100 FT DEPTH CHANGE, 9 KN 
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PITCH - 1° PER INCH 




TIME - 80 SEC PER INCH 



Figure 113 - RUN 2 
100 FT DEPTH CHANGE, 9 KN 
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PLANE DEFLECTIONS - 10° PER INCH 
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TIME - 80 SEC PER INCH 



Figure 114 - RUN 2 
100 FT DEPTH CHANGE, 9 KN 
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TIME 



80 SEC PER INCH 



Figure 115 - RON 3 
100 FT DEPTH CHANGE, 11 KN 
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TIME - 80 SEC PER INCH 



Figure 116 - RUN 3 
100 FT DEPTH CHANGE, 11 KN 
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PLANE DEFLECTIONS - 10° PER INCH 
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Figure 117 - RON 3 
100 FT DEPTH CHANGE, 11 KN 
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TIME 



80 SEC PER INCH 



Figure 118 - RON 4 
100 FT DEPTH CHANGE, 13 



PITCH - 1° PER INCH 
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TIME - 80 SEC PER INCH 



Figure 119 - RUN 4 
100 FT DEPTH CHANGE, 13 KN 
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PLANE DEFLECTIONS - 10° PER INCH 
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TIME - 80 SEC PER INCH 



Figure 120 - RON 4 
100 FT DEPTH CHANGE, 13 KN 



200 



DEPTH 



x 

CJ 

2 



D* 

W 

Pu 

H 



I 



D 





TIME - 80 SEC PER INCH 



Figure 121 - RUN 5 
100 FT DEPTH CHANGE, 15 KN 
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PITCH - 1° PER INCH 




TIME - 80 SEC PER INCH 



Figure 122 - RUN 5 
100 FT DEPTH CHANGE, 15 KN 
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PLANE DEFLECTIONS - 10° PER INCH 
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Figure 123 - RUN 5 
100 FT DEPTH CHANGE, 15 KN 
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submarines the performance of the controller even for hard 
turns is very satisfactory. 

After both maneuvers have been studied independently 
the combination of them leads to Fig. 136-141 and Table 16. 
It is obvious that both parts of the combined maneuver 
influence each other. The time required to reach the ordered 
depth increased with increasing rudder angle. At the same 
time the yaw-angle reached after 400 s decreased by about 
20° compared to a turn without depth change. The overshoot 
experienced stayed still within the design specifications. 



Table 16 - Course and depth change of 100 ft 



Rudder 
angle 
in ° 


Depth 
reached 
in sec 


Max 
pitch 
in ° 


Overshoot 
in ft 


Max speed 
deviation 
in kn 


Yaw 
in 0 


10 


8 5 


1 . 54 


2.97 


2.08 


70. 7 


20 


54 


2.51 


3. 32 


2.94 


102.8 


30 


96 


3.27 


4.77 


3.9 1 


120.3 



3 • Cut cf trim conditions 

All test runs performed indicated that the speed was 
reduced due to additional drag introduced by all maneuvers. 
Frcm Fig. ICS one must conclude that the submarine is not 
in trim during maneuvers. This out of trim condtion has 
clearly an effect on the performance of the' submarine. But 
as the controller is capable of handling these deviations it 
is not advisable to try to trim the boat temporarily during 
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• *1D . 

1000 FT PER INCH 



Figure 124 - COURSE CHANGE, HORIZONTAL PLANS 
RUDDER ANGLE = 10°, SPEED = 11 KN 
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SPEED - 2 KN PER INCH 
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Figure 125 - COURSE CHANGE 
RUDDER ANGLE = 10°, SPEED = 11 KN 
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DEPTH - 5 FT PER INCH 
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TIME - 80 SEC PER INCH 

Figure 126 - COURSE CHANGE 
RUDDER ANGLE = 10°, SPEED = 11 KN 
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PITCH - 2° PER INCH 




TIME - 80 SEC' PER INCH 



Figure 127 - COURSE CHANGE 
RUDDER ANGLE = 10°, SPEED = 11 KN 
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Figure 128 - COURSE CHANGE , HORIZONTAL PLANE 
RODDER ANGLE = 20°, SPEED = 11 KN 
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SPEED - 2 KN PER INCH 
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TIME - 80 SEC PER INCH 



Figure 129 - COURSE CHANGE 
RUDDER ANGLE = 20°, SPEED = 11 KN 
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DEPTH - 5 FT PER INCH 
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TIME - 80 SEC PER INCH 



Figure 130 - COORSE CHANGE 
RUDDER ANGLE = 20°, SPEED = 
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Figure 131 - COURSE CHANGE 
RUDDER ANGLE = 20°, SPEED = 11 KN 
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Figure 132 - COURSE CHANGE, HORIZONTAL PLANS 
RUDDER ANGLE = 30°, SPEED = 11 KN 
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SPEED - 2 KN PER INCH 




TIME - 80 SEC PER INCH 



Figure 133 - COURSE CHANGE 
RUDDER ANGLE = 30°, SPEED = 1 1 KN 
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DEPTH - 5 FT PER INCH 
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TIME - 80 SEC PER INCH 



Figure 134 - COURSE CHANGE 
RUDDER ANGLE = 30°, SPEED = 11 KN 
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PITCH - 2° PER INCH 




TIME - 80 SEC PER INCH 



Figure 135 - COORSE CHANGE 
RODDER ANGLE = 30°, SPEED = 1 1 KN 
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TIME - 80 SEC PER INCH 



Figure 136 - COURSE AND 100 FT DEPTH CHANGE 
RUDDER ANGLE = 10°, SPEED = 11 KN 
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Figure 137 - 
RODDER 



COURSE AND 100 FT DEPTH CHANGE 
ANGLE = 10°, SPEED = 11 KN 
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Figure 138 - 
RODDER 



COORSE AND 100 FT DEPTH CHANGE 
ANGLE = 20°, SPEED = 11 KN 
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PITCH - 2° PER INCH 
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TIME - 80 SEC PER INCH 



Figure 139 - COURSE AND 100 FT DEPTH CHANGE 
RUDDER ANGLE = 20°, SPEED = 11 KN 
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DEPTH - 17 FT PER INCH 




Figure 140 - 
RUDDER 



COURSE AND 100 ?T DEPTH CHANGE 
ANGLE = 30°, SPEED = 1 1 KN 
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PITCH - 2° PER INCH 
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TIME - 80 SEC PER INCH 



Figure 1U 1 - 
RUDDER 



COURSE AND 100 FT DEPTH CHANGE 
ANGLE = 30°, SPEED = 11 KN 
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maneuvers . 

Tc demonstrate the influence of the out of trim conditions 
100 ft depth changes were simulated. First, the correct 
forward and aft trim for the ordered speed of 11 kn was 
maintained while the submarine was too heavy or too light 
overall. Second, the correct overall weight was used and 
forward and aft trim changed by the same amount, but 
opposite in sign. 



Table 17 - Incorrect overall weight 



Weight 
error 
in lbs 


Depth 
r eached 
in sec 


overshoot 
in ft 


Steady-state 


error in 


pitch 
in ° 


depth 
in ft 


+ 2000 


64.0 


3.72 


0.035 


C.440 


+ 1000 


65.0 


3.41 


0.018 


0.210 


0 


66.0 


3. 10 


0.000 


0.000 


-1000 


87.5 


2.76 


-0.018 


-0.315 


-2000 


S9.0 


2.45 


-0.037 


-0.516 



Tables 17 and 18 show the influence of trim changes. A 
change in the overall weight of 2000 lb and a transfer of 
800 lb from the aft to the forward trim tank or vice versa 
is required for the adjacent 2 kn intervals. The overshoot 
behaves as expected, i.e. when the boat is too heavy overall 
or the bow is too heavy the overshoot increases. Vice versa 
the overshoot decreases when the submarine is too light. 
During all maneuvers the speed decreases, which causes 
according tc Fig. 108 too heavy overall and too heavy 
forward conditions. This explains the increased overshoot 
observed for the depth changes simulated before. 



224 



Table 18 - Incorrect forward trim 



Forward 


Eepth 




Steady-state error in 


trim 


reached 


overshoot 


pitch 


depth 


in lbs 


in sec 


in ft 


in 0 


in ft 


+ 800 


83.0 


4 . 17 


-0.067 


0.790 


+ 400 


65.0 


3.63 


-0.034 


0.380 


0 


86.0 


3. 10 


0.000 


0.000 


-400 


87.0 


2.56 


0.034 


-0.434 


-800 


50.0 


2.00 


0.067 


-0.840 



A new feature experienced during these trials is a 
steady-state error in depth as well as in pitch after the 
submarine has regained its original ordered speed. These 
steady-state errrors are small for relatively great cut of 
trim conditions as 2000 lb in overall weight and 800 lb 
heavy forward. If the disturbances become greater it is 
clearly necessary to prevent these steady-state errors. 
There are basically two alternatives. First, correct the 
trim. Second, increase the sensitivity, i.e. the gains of 
the compensator for small depth and pitch errors. 
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VI . CONCLUSIONS 
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The controller, designed on the basis of the linear 
model dynamics for 9 kn, showed the following performance, 
when implemented in the non-linear model: 

a. ) The design specifications for a speed range from 

7 - 15 kn were satisfied. 

b. ) Out of trim conditions led to small steady-state 

errors . 

c. ) When operated in depth keeping mode in a turn the 

controller performed satisfactorily. 

The compensated system is rather insensitive to speed. 
Thus all problems related to gain switching, like chattering 
and discontinuities in command plane angles, are avoided. 
This is especially important because the speed changes 
significantly during maneuvers. 

The design was only concerned with the derivation of the 
transfer functions for the cascaded compensator. When 
implemented in hardware it has the following desiranle 
features : 

✓ 

* Minimal instrumentation 

As no rate information is required only simple sensors for 
depth and pitch angle are necessary, i.e. no inertial 
guidance system. 

* Low cost, weight, and size 

The simplicity of the compensator transfer functions makes 
them easily realizable in physical hardware at low 
manufacturing cost. Weight and size requirements are very 
small, another important factor especially for small ccastal 
submarines. 

* Reliability 

The automatic controller can be realized with a set of 
physical components with a well known high reliability. High 
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component reliability and a small number of components will 
generally result in a high system reliability. 



E. TOTAL DECOUPLING 

As for the steady-state decoupling scheme the total 
decoupling is based on the linear model. The determination 
of the compensator matrix is an easy mathematical process. 
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specific steed. Test runs showed that a compensator 
calculated for one speed was capable of covering a very 
small speed interval. In order to cover a large speed range 
as required in our problem the compensator has to be very 
complex because the gain and the root-locations have to be 
adjusted in very small step sizes. The influence of 
ncr-linearitie s was not considered as these will disturb the 
total decoupling scheme even more. 



As result of this investigation it is concluded that the 
total decoupling scheme seems not to be practical. The 
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E. PITCHING 
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G. AUXILIARY EQUATIONS 
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a 1 * a 2 ' a 3 
v i « 
b J. b 2 > b 3 
' • . 
Cl» c 2 , c 3 

I I I 



Sets of nnn-d l^.ens lof.a t coefficients used In the pro- 
pulsion equation above. The set vfcich will be in effect 
at any ti.T.e during a siniiatei .tancuver viLL depend on the 
value of n and the nur.be rs , V:^, ky 
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APPENDIX B 



NOMENCLATURE 



SYMBOL 



DEFINITION 



. A dot over any symbol signi- 

fies differentiation with res- 
pect to tine. 

B Buoyancy force which is posi- 

tive upwards . 



n 



SL 

D 



u 



V 



V 



Mass of the submarine including 
the water in the free Hooding 
spaces . 

Overall length of the submarine 

Linear velocity of origin of 
body axes relative to an earth- 
fixed axis sys ten. 

Component of U along the body 
x-axis. 

Component of U along the body 
y-a x Is . 

Component of U along the body 
z- ax I s . 
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Command speed: A steady v.ilue 

of u for a Riven propcLler rpm 
when and control surface 

angles are zero- Sign changes 
with propeller reversal. 

Longitudinal axis of the body 
fixed coordinate axis system. 



Transverse axis of the body 
fixed coordinate axis systen. 



z 



X 



o 



Vertical axis of the body fixed 
coordinate axis systen. 

Distance along the x Q axis of an 
earth-fixed axis systen. 



Distance along the y Q axis of an 
earth-fixed axis systen. 

Distance along the z- Q axis of an 
earth-fixed axis system. 



Conponcnt of angular velocity 
about the body fixed x-axis. 



Component of angular velocity 
about the body fixed y-axis. 



Conponcnt of angular velocity 
about the body fixed z-axls. 



z 



B 



The z % coordlnate of the center 
of buoyance (CS) of the subma- 
rine. 
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<< 

e 


Angle of attack. 
Ang le of drift. 


Sb, Dfe 


Deflection of bowp lane ( or 
• a 1 lp lane ) 


Sr j Dr- 


Deflection of rudder. 


Ss ; D 3 


Deflection of aternplane. 


i 

n 

e 

$ 

* 

C 


The ratio u c /u. 

Pi t ch ang le . 

Taw angle. 

Rol 1 angle. 

Mass density of sea water. 


u i 


Weight of water blown fron a 
particular ballast tank ident- 
ified by the integer assigned 
to the index 1. 


63 


Angular velocity. 


t 


Tine . 


x ti 


Location along the body x-axts 
of the center of mass of thp i c ^ 

balJast tank when this tank is 
filled with sea water. 
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< f *>p 



I 



x 



Propulsion force (see auxi- 
liary equations and relation- 
ships). 

Moment of Inertia of a sub- 
marine about the x-axls. 



I 



7 



Moment of Inertia of a sub- 
marine about the y-axis. 



I 



z 



Moment of Inertia of a sub- 
marine about the z-axls. 



K p- K p'* K p|p|'» K qr* 
K r'* K r* K v' K W p. K.l 
K v* K v|vJ / * K w> K $ r ' 



Non-dimensional constants each 
of which is assigned to a parti- 
cular force tern in the equation 
of motion about the body x-axis. 



v- 



M 1 
r r 



M 1 

rp 



AM 1 

rp 



M, 



q | 6s 1 



Mi I , M. 1 , M 1 , M 1 , M 1 , M * , 

|vjq V v r ’ vo* on* * 



vr vp qn 



K * , M | i , M, . * , M ’ , M * , M ' , 
v v v v • vw * vv 6s 



M .. 9 , M , * , M t | , 1 , M , , 1 

ob * wn * w w n 6 s n 



Non-dimensional constants each 
of which Is assigned to a parti- 
cular force tern In the equation 
of motion about the body y-axls. 
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V' %,’• V' V- | r | 6 r ' * N |v| r ’ 



N i vj • vj 1 V • S 1 N 1 

P • s v • s wp ’ rn' • ** • V 



V V 



’• r ' ' N irn*'* S vn*’- 



Kon-dlncns tonal constants each 
of which Is assigned to a parti- 
cular force tern In the equation 
of motion about the body r-axli. 



5 1 

v v 



X 1 



X ' 

r r 



rp 



X 1 
v r 



X • 
wq 



T t v * V * Y • V * 

uu # vv * vv * o ri r ’ 5 si a 1 

Y • T * Y • Y 1 

*<5 bib * vvn 1 wwn * * isisn’ * 

*i ri rn * 



Non-dl mens tonal constants each 
of which la assigned to a parti- 
cular force terra In the equation 
of notion along the body x-axli . 




Kon-dlncns tonal constants each 
of which is assigned to a parti 
cular force terra in the equatlo 
of notion along the body y-axis 



Non-dlnens tonal constants each 

« 

of which Is assigned to a parti 
cular forcr* tern In the equatlo 
of notion along the body z-axls 
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HYDEODYNAMIC COEFFICIENTS 



OF SIMULATION 
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APPENDIX D 



DSL-PROGRAMS AND ELOCK DIAGRAMS 



A. COMPENSA1ED LINEAR MODEL 
(STEADY-STATE DECOUPLING) 



B. COMPENSATED LINEAR MODEL 
(TOTAL DECOUPLING) 



C. COMPENSATED NON-LINEAR MODEL 
(STEADY-STATE DECOUPLING) 
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COMPENSATED LINEAR MODEL ( STEADY -STATE DECOUPLING) 
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EFFCP LIMIT CALCULAT I CN 
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LL EN CRW ( NPLOT ) 



COMPENSATED LINEAR MODEL (TOTAL DECOUPLING) 
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COMPENSATED LINEAR MCDEL (TCTAL DECOUPLING) 
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